#include "modules/CtrlModule/PassivePlanner/FrontPushableObsPlanner.h"
#include "lib/Time.h"
#include "lib/WrapFuncs.h"

#include "data_struct/base/DataSet.h"

namespace  behavior_controller
{
    FrontPushableObsPlanner front_pushable_obs_planner;
    void FrontPushableObsPlanner::run(double &linear_vel, double &angular_vel)
    {
        if(push_able)
        {

        }
        else
        {


        }
        //  调用规划新路径程序
        finished = true;
        push_able= false;
        front_obs[front_obs.size()-1].first=true;
    }
}